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(54) DETECTION DEVICE OF VEHICLE AZIMUTH 
(57)Abstract: 

PURPOSE: To eliminate the influence of a disturbance magnetic 
field as the best of its ability and to correct the detection error 
with high accuracy. 

CONSTITUTION: An X axis direction component and a Y axis 
direction component of an input magnetic vector are discretely 
collected as correction data (steps 110. 111). When the number of 
pieces of correction data becomes four, a reference point of an 
azimuth circle is calculated based on the collected correction data 
(step 1 14) and renewed (step 115). At that time, an amount of 
variation in the X axis direction component and an amount of 
variation in the Y direction component are checked (step 106). 
When they are equal to or greater than an upper value, the 
correction data which has been collected so far is discarded (step 
116). 
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1 ■ 

^{bfi3!»i^SfiiJW±©lS^«C^^*2lHlt*;®<!:*«^-r 4 C i 

*»). c:©mji*5#mtB^^jS"^'*'5>^afc^^lHlt»i.® 
i *im-r s c <!: ^i^® i -r ■smMfli::^{a«ittJJ^a.. 

J:CX?ijEffl7=-^'©ilX*K^"C*ti. ^SB#r^rt{c^X© 
ffliE«7=^- i?5rJRSi L^#J:c^^^i^{<:^^te0t*;SS<!:*lM■r 
[0 00 1] 

©■c*s. 

[0 00 2] 

0 = I an-' C (Vy-/8) / <Vx- 
[0 00 5] Lii^Ltjiifih. C©ii^. :&fiR©4i'C\'^ . 
C0*»P>fiam-fe>1^©*tffi"^*i^<^-^- <Vx. Vy) tc 

tS]3i>^-^i' h;i'©:;?ioi^*Ji>'C^''^-5>*'^> ■^^^"-'•'^ 

fc^^StttSET**). *fca-ifK:^5S?nfJSllHlKliIK:j; 
■2>ftlUJ^M©iffiiE*?St»^'©'*^"^*-5>» -^-C-C. 
J5ligiilJ5s|51©j|)56^r^--!''«^^'''^C<i^'«f< ■ ^SSfi© 
^■ft«:J:€>«ltbSII©ffiI«reS6W«:if^Ci©^Jfi6!tc so 



!^§a¥8-3 1 326 1 

2- ■ 

^?j^a*^tHr ©i 

[0 0 0 3] -r^ii^i. it^-rs2# (X. y#) om. 
%^m^=f■ (xtta-zju. Ytt=>-/;i') *wrsas»^ 

>-t^«r. ■&©XfA*»M©S$:&I^I (»W©iiff:&i°i) 
{CiO. ^E-©Yf4**M©ifi:?^I^«:<!:0. X. YIA©!&: 

OS. ccf. mM©iitT:m6i ixm tmsm.-^if h 
^^^) ©m«i*R. 9m<oxw3^<oiim&^a. 

ffiT-5.A;tlSam'<d' hJU©Xfft:&{fiJfiS»Vx*sJ:tXYtt 
imfS^y y«. TIB < 1 ) *JJ:iX ( 2 ) Setcfc OSS 

V X = R • c o s 0 + or •••(!) 
Vy =R • s i n0 + /3 • • • 02) 

20 [ 0 0 0 4 ] -3* 0 , i^ttimmfp-v^mifimmism 

t/cB$<DV X. V y =&]ffiSffi±-C}i< ^d:6«. S4«:^ 
•rJ:^«:, R (iilT, c©P3*:&fiLP3ii¥^) *siS*»n 
S. i&«c;^«:. *&R©«1»/Ci\^C0©ffi8!« <o. (8) 
-C^O. ^S»R CC-C. mM©?ISaSa. (8 

s, m«. :fi^^ffiR©xi*. Ytt-ttt-eh«:ot»r, -e 
©fi^ffl <vx... . vy... ) . (vx.,. . 

Vy... ) «:^J*«>CifC<fc»3. TIB (3) *J*Jf 
( 4 ) SCslP e>SfiaS a *JiCX/S «:f#*C i *S-Clf 4. 
30 a= (Vx... +Vx.,, ) X2 • V (3) 
/3= (Vy... +Vy.,, ) /2 • • • (4) 

2t)satEb-c*jw«. *M©S!l<r©jt?f:*r{i0«TK 

(5) ^J:»3*«?)€>CiAir#4. 
a) ] • • •. (5) 

[0006] c©mMffl:^{4t^fflJ?s-c«. mSB^raj&i 

gigf SStc. «IHiXtt:&I^QfiS^5•*^J:^/«lmY«:fr|6l^£ 

^-u-r. c©}i6tBi/fciatf.<!55fflffi«s*<!:rrtcieif.3n 

•C. ffliEfflT^-f iC.-CgttScW<CJR«3iaSC©iajS«i 
C n ^©iBlStiSM^.*?rai4 R?JS©'*''i:\*<&*ii>. C 

©*'Cv^s©ii^{4g3!p6mM©xai:3?iai*j,fci^Yfi6:^r{6j 
©«^*5S«i). c©^ai)/c«fiafi*mM©frl/i>X«i 
:^[6j*jic)fYf4:^(fi)©^?ifia' . <3' iotmSiiBis 



(3) !}#§a^8-3 1 3 2 6 1 

3 4 

[0 00 7] [0011] 

[»B835i«^l/J;^'iT'2>^Si] A;^a»'^i' h-'l'©^ [mSEim^ti>tcA<D^m C:<0J:'>tJim6^i:m^•i■ 
■cI*. ||Bg©«6M»^<t<tliSaMm(Cj:^»^S!<t <DSIIe]^#%S^-ri£IslTOS«:S-:JC>r^fi£lHl«Sg?r*il 

«iD£MS*©R3fi©*'C\#.. -r^rfc^if/ctc^feens imr-SJ:9«:Lfcfc©-C*S. IB3|%I8 (18*^3 

*PS©x#:^i6]*jJ;i>'Yf*:'^rS]®*saji»- ^^©^i^ cc^2.aBj) «, ^ i ^Hj{ctec»-c, iauffigaasr^a 

©XI4:^(6]*JJ;CXYttl7?|fi)©«JaSa' . /8' tL. C©ma*ifPWB^«iErj&S*i^. ^Hgiitm 

•r. mhrnm-ifiS-c^c^icttz,. <!:*iM-rs<fc5«:6fcfc©-c**. »4*w (a*3S4 

[0 0 0 8] ^cij. miWM,^^t&-^fc.wmm^mkm ic^^^m) «. ^ i ^bjk:*jc»-c, i@HifflKg«rB#ra 

mmt b-C. <#g3¥^2 - 2 9 3 6 1 *jJ:D>'ffiiE«f'-5'©iRmtfc?St L. mSB#part«:;>j© 
fc©*i*;*i C©mMffl:&fii<*tti^S-Ctt. l^i£lHl-C 20 ffliEffl7'-^'?:iR«Lt#*C»tB^. IHffl«»i«3£-r 

©fii5rffll,^-ClS)5ilHl©<t#S'J>*S!<b-rSia®m:^fi:«r [0012] 

*/c. i5)««:. i^iSlEl©i#^^^^b-re* [f'pra] L/c*io-cc©»B^fcj:ii«. srmil-cjj. 

M©iiftfc*«i>-cte<. *©«. i^tllHl©i^©«6 A;^iesi'<i' ^^^©xtt:^l^afiS^*iJ:cKYtt:^fi£^*s 

ffi^:??{4iiaHift3{pe.i£!Hift*s»ibfc<»:t©if6?a^ mjEm7=-^tLxmfkff}icm^miimsti. c<Df(xm 

CtfPJ ©!*©«*) «r<^iE-r4. C© C©ti^. *M©ia3^*m^jaiIffiB!l««:S-:> 

5Jl4iI?:*8?)2.Ct*i-C#, J:"5mill4©iiEl-»jl?f*ti© 30 "f-^ifiWmSti. ■e©«liEraf'-a'S:fflC»-C©1ftffia 

[0009] Lii°LfJii}i'i>^ C ©:^Mffl:&{4^UiSIS-C i' h J\^<OXU:^(^m^isJ:afY^:^mm^}ifiWJEm^- 
^a^cc<fc•2>S^W?^±<B^*t/T^»^tl»*^fc^i){c:^#>J:^S 40 mjE*m±tiixi. 

iE^MiiimK>. t^a^m©ffliEffig*5®T-rs. */c. [0013] msmMxit. At)mM-<i' h;i'©xwi:^ 

C©mMffl:^{4^a3SS'C«. mmUMMEm^-iiUtf |S]fi)c^*sJ:C/YI4:&|i3fiS;^*iffijEffl7=-3f<bbri§ttJta«) 

1iiE=&!at.»?>citc)a:$. ti■t^^t^ijt^f:^^ii*5^iiE^^^^.. c©^^. :*)I*s<?9; 

[00 1 0] $:f£Bj{ic©J:^^ii«Si^^^"^S'<:d?){C tg^miS (mt*. 2. 8 km/h*?S) iiScotT^^ii 

j5£$#i/cfc©-c. -e-©sfl^i"^''2>i«^'5>**> mmjimisi ^ifimtm^^ini>t. ^msi^f:^^^4©ffliEA^^±^n 

fia5|©^Jfe4:z.-if{c5St>«>Ci!5c< . ««S©^^k{C i>. mtf. ffliEfflf'-^'©iRm*543|K5n. *3S*5f^ 

J:-S^m^^©ffiiE*etie^'<^^T^ C i^ioJtl-C. mti^:5iS«±i>i-SS-C«im3i?f:^{4©l«iE*5^±$ 

mLMM©fi;aP?r-C#»2.KOgfK50r«lffi|eM©tiiE n?,. ||4#£Bj-ciJ. hJlOXUISf^lS.^ 



[0 0 14] 

gg. 3«C©A/D^^lHl!?S2- l*jJ:Of2-2CCJ:i9 
ftiS^S L E D'PL C D-'^**^^^©*5^a, 5 



(4) 4#ga^8-3 1 3 2 6 1 

6 

* [0015] iimH2>-9-i «> mmkmf^^6L^<Dx 

li^W^H - 1 *jJ:C/YI43-r^H -2<t. X$43'<;U 
1 - 1 *jJ:CKYlAa ;H - 2 {C±-r4A:t!fia^--4i' h 
;l'©Xtili*l6]fiS^*jJ:c;fYlili^|fii;iR^tci6(;/c<jlHlSEE 
frMIt .^_X7 > T 3 fc^ -4 . 

^Tl^5. «t*5. ill^IeI8S3{C«, 

*j|9:we.n. c©-^*'jK:mFi©Xf4:m«jfe<tcxYi*:3& 
[0016] yjtc, ccDmMmT^fiitftWJiatcfcw^!^ 

mW<J«ifP«:-p(,i-c, EIl«:m-r7ci-5=-i'-h^&#M 
W:&l^fiS;»Vy©A/D^jfeffi=SrK*)i* r^l 

0 1). ^J^{fcKis*tf ^) <;^-f ^:/i 02) . c©^ 

i^^k^astc J: rff e>iTS xfft:^rS]ts^fc J:c/Yf4:^riqj 

^^©¥i^fii«:VX*Jj:C/YYfr*. 3;fc. vt^VtC 

«ffi3#i-ct>smffi©xtt:*i$i*jJ:{yfYtt:;^i^i©««bli 

a*jJ:af(3 (t7]«9fii) ^^^^fflb. X«l??IiiI^VX*5 
J:CJfYI4:&|njfiS»VY«:*fl,-Cli»i. •> hiias^r 

m» (;:^^f7"10 3). TK (8) SCtcJ:«33KaE(Da 

tT:&{40 (m) >&sai-r5 (x-f fr^io4) . cow 



10 



20 



(3) f 



e (m) = t an-' C (VX- /8 ) / (VY- a) ) 



(6) 



[00 1 7] -g-L-C, ?jI^IhIS83«. r-r^i> + ;l, (S6 

5 ) . S6{'PP§*S1^?§-C*ntf:^f 9 XI 0 6 ^g-rtc;^ 
X 1 0 7 --jlty**. M^O&i'PiK^t tjitut:^^- y 
XI 0 6*ig-C;^^fXl 0 7'^jitr. Xf'fXl 0 6 30 

e.n/c±iJifiiG,., «±-c*n«. m^^mmo-c^^T- 

5; XI 1 6'^jitf. :$:^«>iJ«:*Jl»T. Xf-^Xl 0 6 

[0018] -ffj^i^^. XT^f Xi 0 era. A:tiffim 

•^i? hjU©Xf4:;?|fi3fiK^Vx*Jj:CJfYf*&[fi]fiS»Vy© 

A/D^g%4i*-y->X';>x-rsi*tc. buIsi©-9->X'j 

> i/{c<t -s-C^mS *a/cXli675-|^fi£»V X *J YttT^ 
(fiJfiS^Vy i^lEl©lJ->X ';>XCC<fcr>-Ct*Bi$tlfcX 40 
f 47?|fi]fi)E^3- V X *J J: O' Yl4:^r6]fiS^ V y i ©M^rmm^ 
■fhSAYxfeiC/AVyiLr^ttiL. COJ^^ftS 
A V X *J J; CJf A V y ©ii><t < <t t — *a 

-i'fc.to'Btraitsijffl*'?^^®^' y T^Srife*. C©X 

f-yXl 1 6-C©ffliEffl7'-i'*5J:C^B$raitaiJffl*'5> 

[0019] >^7"9X1 0 BiCteti-C. M^^^tSAV 
x*Jj:C/AVy«:9^*5'i'-r2><!:U^Ci«. jflltCJ: 50 



<tJIIAVx*JJ:CJfAVy©RRIfia^^tSG.., itMA 

[0020] 3S^©)5£{1-C*n«. iaiM^<t*A V X *J 
J;UfA V y »l®^iam^{kaG...^:S^iC<i:«36t 
< . figm^lbfi A V X fcJ: CJf A V y ©ii>a < i fc— 

tJ/ar < }^SLmM.K.J: o -CG... ?rMAfc fc©i^Ef ^fT C 

S!^t«AVx*jJ:c;AVy{Cj(*-r*±PRiiG,», iJE* 

i*i^.<. fiam^{taAVx*Jj:t;fAVy^Srf#ft:<!:tr© 

isb. 2^JS««J-c«. mji^i^«:*j(,ir©figl?ffiM^<tfi 
G... ©]g:;*^{iI<S:M^^<t*AVx*jJ;yfAVy-{C*f-r 
i>±fRBG,^^ . -rtcfc^:^'?---' XI 0 6-Cffll»S±IE 

ffiG,,, iurs»t:«,»-&. cntcjco. ±figffliG,., 
^f©jsi5]B$©«ijMm^i fc «: J: •2. samg:^ 1 6 nsimMK. 



(5) 



1 3 26 1 

8 



[0 02 1 ] ^f^.fT'l O 7-C:». mji-fe>1^5*'6© 
ikitiMMii^2. 8~3 5 km/h-C*ntf;^f-5':/l 0 



9)^ :t-~./^yo-o-r:i,^tj:iityk::x,^y -:fi l o^m 
tj. xf- 5» :n 1 0 "c», ^ 1 0 1 -cffio ii^/c 

^vy-c^stisMS.-^.. <vx. wy ym^Mmmm lo 

[ 0 0 2 2 ] -e L-C . C <DtE^.<l5l?«ffi^.#, ( V X . V 

y) <b-r-c(ciaigsn-ct»-5SiE{f.Hi^M^,'^ (xt 

(n) . Yt (n) ) iz=S:tmL. iBlf.<KffiJl«* (V 
X. Vy) j&sSieteSH^^^^. (Xt (n) . Yt 
(n) ) ?r*'Dil/-CS*€>tlS^fS!R^l^©<5ItlK:fc 

(igLrii^cwni*, -s-^isisi^ffis^ (Vx. V 

y) =&^^(DfetS.HISM«.^. (Xt (n) . Yt (n) ) 

( 0 0 2 3 ] 0 3 4ffll,»-Ciett?£5©IIS* (X t 20 
(n) . Yt <n) ) ©9i®fflS«rA»WCCgiB^-r*. 
ie».Fi^«.'^.P 1 (X t (1 ) . Y t { 1 ) ) . 

P2 (Xt (2) . Yt (2) ) , P3 (Xt (3) . 

Yt (3) ) *J^3n-C*5»). ;^f^s»:/l 1 0{c*Jt> 

riEttf^jf 0^.#.p 4 (vx. Vy) tmmstxfcii-r 

CCDIS^, i2tttt3£0«.'^>P 1 . P 2 . P 3 tcS* I. 
■C», PI. P2. P3***i-r-5iE:&?^«©#^SII? 

Mms 1 . s 2 . S3 lElt^MffiS 

^S,P4l*l^«R«l«S 1. S2. S3©f5in{C<>fiSl/ 
•Cl^JSrl*. C©*i^. iBffiiSffiMS.^P4 30 

»iEttStSlffiS^P4 (Xt (4) . Yt (4) ) tlx 

100 24] ;^^!»7'1 1 1 ■CiElf.^SfflffiS^ (Vx. 
Vy) %iBttHl3£Mti.#, (Xt (n) . Yt (n) ) t 
VX^ttlit, f- 9 :/ 1 0 8 T-eO* > Hi«rT 

1 2 ) . -et-C. iBtf5SSiffi«.#. (X t (n ) . Y t 

(n) ) *54<mx^2nntf. 7*1 1 3-c©ye 
Sictt-c^fy:^! 1 4'^jit*. ;^f-5'7'i 1 4-ct*. 

IS^ffi^.^, (Xt (n) . Yt (n) ) ^jl5R5ffi©4' 

R©»St ^CDffimS*^ 6*MOXtt:^|tiI*J J: Y$A:^ 
I^I©«fiBS*:*Ji). c©*i«)fcirMa<S:mM©ffL/C»X 
$4:^ri6]4iJ<tCXYfil:;&[6]©»!SSa' . ^* iL-TJIfriB 
tt-r-S (y^f-yZfl 15). 

[0 02 5] -e-OT. ;^f-">':^i 1 7.'r'j-:f 
1 0 4-C»l±JL/£:jt^f:&{40 (m) ^ss^UJ:^-^^. ;^ 
7^'-»7-l 1 5-CK«fiElf.$i^'t^KSa' • ^' 
)&:*>t:^{4R©»»S,#.OffiSi (a' . ) «. 50 



>7''j>i^^»|{c*3i:f?.;^f-!y7'i 0 4■c<7:)3i^f:^^40 
(m)©g:aj^K:ffli>e>#i-5>. tc*j« ;^7^y7"i i«:*j 

I.^TiEtl.iSJ«ffi«,'**iiEtg.5iSffiS^^.iO-C^3n& 

S/cXf y:?"! 1 3«:*5C.>ria»lS5EffiS^ 
( XJ_ J. n)_^ Yt (n) ) fli4mfkiL':>X\,'^ti\.-^i n 

;:^7' » 1 1 7 '"^atf . c ntc J: ») , *M*na^«:fBJa 
ci*i-ct«cc>. c©^^. ^1■SL^lSl©fl^^3■:>fcA:^)^a 

^■-<^Ph)V<Dmm^ (Vx. Vy) jS*. ;^f^5r:?'l 1 0 

[0027]-%. aii^tfSrff o-cSfoo, Mitm^n 

(Vx, Vy) *iiEte<^ffim^.P2' (a3# 
M) tL-Cfflai3*a^,<!:. iE«.Si^m^P 1 «:«l3'C^i 
^-5#B1IR^^S 1 tciEtf{^MS*P2* *sfiSO-C 
t,>%U©-C. iEttf^fflJl«,#.P2' *iiElf.5i^ffi«.#.P 

2' ti/t^stis. -et/r, ^©•9->7'y>d^«:j: 

t>^tcX:bmM'<i' i-}l'<Dm^!^ (Vx. Vy) *5iB1t 
t^ffiM^.^,P3' tLxmmStii>. C©JS^ 
©iBltiSffiM«l.^P 3 ' »SBteflD£l^«(^P 2 ' ^rif'C^ 
i-rS^^jMl/^MllcS 2' «:{4g-r-5fc*. IBlf.Ig}£0l« 

[0028] iBtt.JiSSIg«.^P2* SrSuet-fcta 

ici^<j7$ titcmmummti >? > ^^ts. -x<o^>:fv > 
4/^X8-c©iBttii|ISJ^«*P3' ©ata^wr^-iJ^hr 
A/D ^^7==- 3'©1f ^i^StclBlt 

<is«i^^*P3' *iaa3n^>*i. c©iEjti5^ffl]ai^.^ 

P3 • *sBtf.fitSM«iU-C^5£0?i«:t^«SI*s^3tB$ 

7a--r2>i. ;^f-v^l 0 9•C©YES«:Ic:C■C;^■f• 
•;;:/l 1 B^-jiOc ;^7--:'7'i 1 6r». -etiS-ciciR 
*L■/c^SiEfflx- ^'*jJ:a'B#raitS'Jffl*'?>f©i' V7 

5r?T^. cn«:j:«3. *nsTtcj|xm?nrt,»siBtS5i 
^ffis^pi. P2' ^mm^ti. ^(ommucmiEm 

[ 0 0 2 9 ] -r^tfc-fe, *jy6«^«-C«3:. 3iS©3i^^.^ 
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